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CONTROL CALCULATION DEVICE 

TECH NICAL FIELD FIELD OF THE INVENTION 
[0001] The present invention relates to a control operation device capable of 
controlling a position of a controlled object as instructed by a command. Thotis For 
example, it relates to a control operation device for use in a servo control device for 
performing positioning control of a load machine connected to an electric motor by 
generating a current (torque) command to the electric motor based on an inputted 
position command and a detected position/speed detection value of the electric motor. 

B ACKGROUND TEC H NIOUE BACKGROUND OF THE INVENTION 
[0002] In a conventional control operation device using a feed-forward signal, PID 
control is performed so that a position feed-fonA^ard signal and a position detection 
value coincide with each other and that a speed feed-forward signal and a speed 
detection value coincide with each other, (see, e.g.. Potent Document 1 Japanese Patent 
No. 3.214.270 fJP '270^ ^ 

Fig. 7 is a block diagram showing a structure of a conventional motor control 
system for controlling a position, etc., of a motor. In this figure, the reference numeral 
"1" denotes an electric motor for driving machinery as a load, "2" denotes a torque 
transmission mechanism connected to the electric motor 1, "3" denotes load machinery 
to be driven by the electric motor 1 connected to the torque-transmission mechanism 2, 
"19" denotes a position and speed detector which detects an actual speed and an actual 
position of the electric motor 1 and outputs an actual speed signal com and an actual 
position signal Sm, and "5" denotes a torque control circuit. 

[0003] A subtracter 24 subtracts a first simulated position signal 0ai from a position 
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command signal 9m*, and outputs the obtained error signal (9m*-0ai) to the first 
position control circuit 25. The first position control circuit 25 outputs a first speed 
signal a> i* to a subtracter 26 so as to decrease the error signal (9m*-0ai) to control so 
that 9ai follows 9m*. The subtracter 26 subtracts a first simulated speed signal coai 
from the first speed signal coi* which is an output of the first position control circuit 25, 
and outputs the obtained error signal (a)i*-(OAi) to a first speed control circuit 16. The 
first speed control circuit 16 inputs the error signal (a)i*-a)Ai) to control so that the error 
signal (o)i*-a)Ai) decreases, and outputs a first torque signal Ti* to a subtracter 15. 
The subtracter 15 subtracts an output Tc of a compensating torque operational circuit 14 
from the first torque signal Ti*, and outputs the obtained third torque signal T3* to an 
adder 6 and a subtracter 18. The subtracter 18 subtracts a simulated transfer torque 
signal Tf which is an output of the torque transmission mechanism simulated circuit 10 
from the third torque signal T3*, and outputs the obtained error signal (T3*-Tf) to an 
electric motor simulated circuit 27. The electric motor simulated circuit 27 simulates 
the transfer function of the electric motor 1, inputs (T3*-Tf), outputs a first simulated 
position signal 9ai to a subtracter 20 and the subtracter 24, and further outputs a first 
simulated speed signal coai to a subtracter 11, a subtracter 12 and a subtracter 22. 
The subtracter 11 subtracts a second simulated speed signal coa2 from the first 
simulated speed signal coai, and outputs the obtained error signal (a)Ai-a)A2) to the 
torque transmission mechanism simulated circuit 10. The torque transmission 
mechanism simulated circuit 10 simulates the transfer function of the torque 
transmission mechanism 2, inputs the error signal (a)ArC0A2), and outputs a simulated 
transfer torque signal Tf to the load machinery simulated circuit 9 and the subtracter 18. 
The load machinery simulated circuit 9 simulates the transfer function of the load 
machinery 3, inputs the torque signal Tf, and outputs the second simulated speed signal 
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0)a2 to the subtracter 11 and the subtracter 12. The subtracter 12 subtracts the second 
simulated speed signal a}A2 from the first simulated speed signal (Oai, and outputs the 
obtained error signal (caAi-(0A2) to a compensating torque operational circuit 14. The 
compensating torque operational circuit 14 inputs the error signal (a>Ai-coA2)/ and 
outputs a compensating torque signal Tc to the subtracter 15 so that the load machinery 
follows the speed command signal (Om*. The subtracter 20 subtracts an actual position 
signal 9m from the first position signal Sai, and outputs the obtained error signal (6Ai-eM) 
to a second position control circuit 21. The second position control circuit 21 outputs 
the speed signal 0)2* to the adder 22 so that the error signal (Qai-Qm) decreases to 
control so that 9m follows 9ai. The adder 22 adds the first speed signal coai and a 
second speed signal 0)2* and outputs to a subtracter 23. The subtracter 23 subtracts 
the actual speed signal com from an output of the adder 22, and outputs the obtained 
error signal (0)2*+ (Oai-com) to a second speed control circuit 8. The second speed 
control circuit 8 outputs a second torque signal T2* to the adder 6 so that the velocity 
error (coai-o)m) decreases to control so that the actual speed signal cdm follows the first 
simulated speed signal (Oai. The adder 6 adds the third torque signal T3* and the 
second torque signal T2*, and outputs the obtained torque command signal Tm* to the 
torque control circuit 5. The torque control circuit 5 inputs a torque command signal 
Tm* to drive the electric motor 1. The electric motor 1 drives the load mechanism 3 via 
the torque transmission mechanism 2. Moreover, the electric motor 1 is provided with 
a position and speed detector 19 for detecting the actual speed and the actual position 
of the electric motor 1 to output the actual speed signal com and the actual position 
signal 9m. 

{0004} Fig. 8 Is a block diagram explaining a second speed control circuit 8. In this 
diagram, the speed control circuit 8 includes a coefficient multiplier 108 having a 
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proportional gain Kv2 and an integrator 109 having an integral gain Kj2. When the 
velocity error signal (com-com) is Inputted, proportional plus Integral control Is performed 
to output a torque signal T2*. Therefore, even if disturbance torque is added, it can be 
controlled so that the speed com of the electric motor 1 follows the first simulated speed 
signal coai. As mentioned above, since it is controlled so that the coai follows com'*' by 
the first speed control circuit 16, the speed q)m of the electric motor 1 is finally 
controlled so as to follow the speed command signal com*. 

Fig. 9 is a block diagram explaining the second position control circuit 21. In 
this diagram, the coefficient multiplier 202 having a gain Kp2 performs proportional 
amplification of the position error (Gai-Sm), and outputs a second speed signal C02*. 
Since it is controlled such that Sai follows 0m*, the position Gm of the electric motor 1 is 
controlled so as to finally follow the position command signal Gm*. 
[0005] In this way, a conventional control operation device performs PID control 
based on the error signal of the feed-forward signal Gai and coai and the detection value 
Gm and o)m to attenuate the impact of errors of a feed-forward model or unknown 
disturbance torques. 

[Patent Document 1: Japoncsc Patent No. 3,211,270 (sgg Page 10 and F ig. 0) 

DI S CLOSURE OF T H E INVENTION 
WtOB kEMS TO B E S OLVED BY T H E INVEN TIOW 
[000 6 ] In a conventional control operation device, PID control is performed, and 
adjustment is only performed er^ by three control parameter values of a proportional 
gain Kp (Kp2 in a conventional case) of a feedback position loop, a proportional gain Kv 
(Kv2 in a conventional case) of a speed loop, and an Integral gain Ki (Ki2 in a 
conventional case). Therefore, there was a drawback that disturbance characteristics 
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cannot be finely adjusted to decrease influences by modeling errors and/or disturbances. 

Moreover, for example. If control such as predictive control, which demonstrates 
an effect by the balance of feed-forward control and feedback control. Is used to 
improve the disturbance characteristic, there was also a problem that the use of such 
control causes a deterioration of the contro ll abi li ty control performance . 

The present invention was made in view of such problems, and aims to provide 
a control operation device capable of finely adjusting the disturbance characteristic 
which attenuates the impact of a modeling error and/or a disturbance even In cases 
where a feed-forward model has an error to an actual controlled object or there was an 
unknown disturbance which was not considered in a model, and also capable of 
applying control such as predictive control which demonstrates an effect by the balance 
of feedback control to Improve command following capability. 

MEAN S TO SOLVE THE PRO B LEMS SUMMARY OF THE INVENTION 
[0007] In the present invention, a control operation device which receives a position 
feed-forward signal (xff), a torque feed-forward signal (tff), and a position detection 
value (xfb) of a controlled object, calculates on opcratiGn amount a manipulated 
variable so that the position detection value (xfb) coincides with the position feed- 
fonward signal (xfQ, and outputs the operation amount manipulated variable , 
comprising: inciudino an error signal calculation unit[[;]] and an error compensation 
operation unit[[,]]. 

whoro i n the The error signal calculation unit outputs a signal given by 
multiplying an error (err) given by subtracting the position detection value (xfb) from 
the position feed-forward signal (xff) by a gain a as an error command (err_reO, and 
outputs a signal given by changing a sign of the error (err) and multiplying a gain & as 
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an error feedback value {err_fb)j-&pi^ 

where i n the The error compensation operation unit controls so that the error 
command (err_ref) and the error feedback value (err_fb) coincide, and outputs an error 
torque command value (err_tref), and adds the torque feed-forward signal (tff) and the 
error torque command value (err_tref) to give the operation amount manipulated 
variable (tref). 

EFFECT S OF THE INVENTION 
[000 8 ] According to the present invention as recited i n claims 1 to 1 , in cases where 
a feed-forward model has an error to an actual controlled object or there is an unknown 
disturbance not considered in a model, there is an advantage that the disturbance 
characteristic can be adjusted finely by adjusting a gain a and a gain |3 in addition to 
three control-parameter values which were adjusted in a conventional control operation 
device. Moreover, even in cases where control which demonstrates an effect by a 
balance of a feedback control is used to improve the disturbance characteristic, for 
example, a command following capability of, e.g., a predictive control, there is an effect 
that the control l ab i lity control performance can be kept well and as a result the entire 
contro l lab i lity control performance can be improved. 

[0000] l^oreover, according to another aspect of the invention oo rec i ted in claim 5 , 
there is an effect that apart from an original feed-forward control, a control having a 
feed-forward can be applied without problem to reduce errors, and as a result the 
contro ll ab ili ty control performance can be improved. 

Moreover, according to another aspect of the invention as recited in claim 6 , 
there Is an effect that apart from original feed-forward control, prediction control can be 
applied without problem to reduce errors, and as a result the contro l lab il ity control 
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performance can be improved. 

Moreover, according to another aspect of tlie invention as rec i ted i n c l aim 1 , 
since a function wliich correlates two parameters Is decided preliminarily, there Is an 
effect that an adjustment time can be shortened by parameters for adjustment in union. 

BRIEF DESCRIPTION OF THE DRAWINGS 
[0010] A preferred embodiment of the present invention will be described with 
reference to the accompanying drawinc wherein: 

[ Fi g. 1] Fig. 1 is a block diagram of a first embodiment showing a structure of 
a control operation device according to the present invention[[.]]; 

[F i g. 2] Fig. 2 is a block diagram showing a structure of an operation 
device[[.]]i 

[Fig. 3] Fig. 3 Is a block diagram showing a structure of an error compensation 
operation unit[[.]]i 

[Fig. 1] Fig. 4 is a block diagram according to a second embodiment[[.]]i 

[Fig. 5] Fig. 5 is a block diagram according to a third embodiment[[.]]i 

[F i g. 6] Fig. 6 is a block diagram according to a fourth embodiment[[.]]; 

[Fig. 7] Fig. 7 is a block diagram showing a structure of a conventional control 
operation device[[.]]j. 

[ F ig. 8] Fig. 8 is a block diagram showing a structure of a second speed 
control clrcuitrr.ll : and 

[F i g. Q] Fig. 9 Is a block diagram showing a structure of a second position 
control circuit. 

PeS CRIPTION OF REFERENCE NUMERA LS 

[0011] 
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100, lOO B , lOOQ lOOD Contro l oporotion dcviCG 

101, 102, 121, 131, 131 Subtracter 
i20 — Error signa l ca l culat i on un i t 

13G — Error compcnGation operat i on un i t 
133, 151 — D i fferent i ator 
436 — Integrator 

122, 123, 12 - 1, 132, 135, 137, 152 Coeffic i ent mu l tip l ier 
440 — Speed control portion 

459 — Feed forward control portion 

460 — Operationa l unit — 

B E S T MOPE FOR CARRYING OUT T H E INVENTION DETAILED DESCRIPTION 

OF THE INVENTION 

[0012] Hereafter, a control operation device according to the present invention will 
be explained with reference to the drawings. The control operation device according to 
the present Invention explained below is an improvement of the portion (A) shown by 
the dashed line of the conventional control system shown in Fig. 7. 
EXAMPLE 1 
[0013] 

Fig. 1 is a block diagram showing a structure of an embodiment of a first 
embodiment of a control operation device according to the present Invention. In Fig. 1, 
"100" denotes a control operation device of the present invention, "101" denotes an 
adder, and "160" denotes an operational unit. Fig. 2 is a block diagram showing the 
structure of the operational unit 160. In Fig. 2, "120" denotes an error signal 
calculation unit, "130" denotes an error compensation operation unit, "121" denotes a 
subtracter, "122" is a sign Inverter, "123" denotes an arithmometer amplifier having a 
coeffic i ent gain a, and "124" denotes an arithmometer amplifier having a coeff i c i ent 
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gain p. 

In such a structure of the control operation device 100, when a torque feed- 
forward signal tff is inputted into the adder 101 and a position feed-forward signal xff 
and position detection signal xfb are inputted into the error signal calculation unit 120, 
the adder 101 inputs the torque feed-forward signal tff and an error torque command 
err_tref calculated by the operation machine 160 to add them, and outputs a torque 
command tref. When the subtracter 121 of the error signal calculation unit 120 
receives an a position feed-forward signal xff and a position detection signal xfb, 
calculates a position error err by performing the subtraction, and outputs the position 
error [[efTJ] err to the sign Inverter 122 and the or i thmomctGr amplifier 123 having a 
coofficicnt gain g. The sign inverter 122 reverses the sign of the inputted position error 
err and outputs it to the or i thmomctcr amplifier 124 having a coeffic i ent gain p. The 
arithmometer amplifier 123 outputs an error command err_ref as an operation result to 
an error compensation operation unit 130, and the ar i thmometer amplifier 124 outputs 
an error feedback value err_fb as an operation result to an error compensation 
operation unit 130. The relation of the input/output of this error signal calculation unit 
120 is expressed by the following expressions. 

err_ref=g • (xff-xfb) (1) 

err_fb=3 • (xfb-xflO (2) 

In these expressions, two cocfficlontG gains a and p denote gains which can be 
set arbitrarily. At this time, if the relation is correlated such that the sum of a and p 
becomes a fixed value 1 (o+p=l), it becomes possible to simplif/ the adjustment since 
adjusting one of them determines the other. The correlation of o and p is not limited 
to such expressions, and can be set arbitrarily. 

The error compensation operation unit 130 receives the error command err_ref 
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and the error feedback value err_fb, performs an error correction operation so that they 
coincides to obtain an error torque command err-tref, and then outputs the error torque 
command to the adder 101. 

[001 4 ] Fig. 3 is a block diagram showing the structure of the error compensation 
operation unit 130. In Fig. 3, "131" and "134" denote subtracters, and "138" denotes 
an adder. Furthermore, "151" and "133" denote differentiators, "136" denotes an 
integrator, and "S" denotes a Laplace operator. "132," "135," "137," and "152" are 
coGfficiGnt mult i p li Gro amplifiers having a coeffic i ent gain Kp, Kv, Kj, Kf, and the 
differentiator 151 and the cocfficiGnt mu l tip l ier amplifier 152 constitute an FF controller 
150. In the case of performing control for according the error command err_ref and 
the error feedback value err_fb as explained here, the structure is not limited to the 
illustrated one. For example, PID control can be employed, or control consisting of 
feed-forward control and feedback control, such as 2-freedom-degree control using a 
model of a controlled object, can be employed. Furthermore, an Inverse transfer 
function compensation using a model of a controlled object or the like can be employed. 
[0015] In this embodiment, the following explanation will be directed to the case in 
which control consisting of feed-forward control and feedback control as shown in Fig. 3 
is used. In Fig. 3, "150" denotes a feed-forward control portion, and the output of the 
error compensation operation unit 130 Is calculated by the expression 3. 

out=Kv • (1+Ki/s) • {Kp • (err_ref-err_fb)+Kf • s • err_ref-s • err_fb} (3) 
Thus, at the time of adjusting the disturbance characteristic, the disturbance 
characteristic can be more finely adjusted since the gain a and the gain p as well as 
gains Kp, Kv, Ki, and Kf can be adjusted, resulting In improved contro l lobillty control 
performance . 

[001 6 ] Fig. 4 is a view showing the structure of a second embodiment. All the 
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elements having the same reference sign as in Figs. 1 and 2 correspond to the elements 
shown In Figs. 1 and 2. This embodiment 2 is different from the first embodiment 1 in 
that a speed feed-forward signal vff in addition to the feed-forward signal of the position 
and the torque is inputted and that a speed control portion 140 is added. In the speed 
control portion 140, proportional plus integral control is generally used in many cases. 

In this case, the error verr between the speed feed-forward signal vff and the 
speed detection value vfb is inputted into the speed control portion 140, and the 
feedback torque command tfb outputted from the speed control portion 140, the torque 
feed-forward signal tff, and the error torque command err_tref outputted from the error 
compensation operation unit 130 of the operational unit 160 are added into a torque 
command value tref which is a manipu l ation amount manipulated variable . 

As explained above, since it is constituted that the usual speed control portion 
140 for compensating the error between the speed feed-forward signal vff and the 
speed detection value vfb separately from the error torque command err_tref calculated 
by the error compensation operation unit 130 in order to compensate the error using 
the position error err is also provided, the characteristic to the disturbance can be 
improved. 

[0017] Fig. 5 is a view showing a structure of a third embodiment. The third 
embodiment 3 is the same as the second embodiment 2 in structure element, but Is 
different from the second embodiment 2 in that the output of the error compensation 
operation unit 130 in the operational unit 160 shown in Fig. 5 serves as an error speed 
command err_vref as opposed to that the output of the error compensation operation 
unit 130 In the operational unit 160 serves as an error torque command err_tref. 

In this case, the speed feed-forward vff and the error speed command err_vref 
are added and the speed detection value vfb is subtracted therefrom to serve as a 
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speed error verr to be inputted into tlie speed control portion 140, and the feedbacl< 
torque command tfb which is an output of the speed control portion 140 and the torque 
feed-forward signal tff are added to be outputted as a torque command tref which is a 
manipu l ation amount manipulated variable . 

[001 8 ] The error compensation operation unit 130 of this embodiment shows the 
case where predictive control is used. 

As predictive control, for example, devices, such as, e.g., a "preview-control 
device" disclosed by Japanese Unexamined Laid-open Patent Publication No. H07- 
028508, and a "preview-control device" disclosed by Japanese Unexamined Laid-open 
Patent Publication No. H05-820489, are known. In cases where the invention disclosed 
by Japanese Unexamined Laid-open Patent Publication No. H07-028508 is used, 
provided that this sampling is i^ sampling, the control input u(i) which minimizes the 
evaluation function J shown by the expression (5) including a prediction interval M, a 
detection delay K, a weighting coefficient Wm, a weighting coefficient a, a weighting 
coefficient c, a weighting coefficient Cd, this time position error e(i-K), and a predicted 
value e*(i+m) of the error ahead of m pieces is obtained by the expression (6). 
[Expression 1] 

r(i) = eiT^ref(i), ya)-err^fb(i), u(i) « vref _err(i) (4) 

M / . 

»(0« yv„Ar(i + m)- Yp„Ay(i-K-ij)-. Tg„u(i-n)+Ee(i-K) (6) 

Here, Ar(i) represents an incremental value for every control period of the 
command r(i), and Ay(l) represents an incremental value for every control period of the 
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output y(i) of the controlled object. Moreover, "Na" and "Nb" represent the degree of 
the denominator and the degree of the numerator, respectively, when the transfer 
characteristic from the control Input "u" to Ay Is represented by a pulse transfer function. 
[0010] The parameters Wm, Pn, 9n, and E in the expression (6) are values calculated 
from a model of a controlled object and the va l ue of each weight the weighting 
coefficients, and since the calculation method is disclosed by the "preview-control 
device" described in Japanese Unexamined Laid-open Patent Publication No. H07- 
028508, the detail will be omitted here. 

Thus, only by substituting a portion of q position contro l portion position control 
portion of a conventional device with the system of the present invention. It becomes 
possible to apply predictive control, which could not be applied until now, resulting In 
improved contro ll ab i l i ty control performance . 

[0020] Fig. 6 Is a figure showing a structure of a fourth embodiment. The fourth 
embodiment 4 is almost the same as the third embodiment 3 shown in Fig. 5, but is 
different only in that the torque feed-forward signal tff Is not inputted. This structure 
can be effectively used in cases where, e.g., a response becomes vibroto l ity oscillating 
or torque saturation occurs when a torque feed-forward signal is used. Thus, even In a 
structure not using a torque feed-forward signal, it becomes possible to demonstrate 
the effects of the present Invention. 

INDU S TRIAL APPLICA B ILITY 
[0021] When there exists an error between the model considered in a feed-forward 
and the actual device, control having a feed-forward lil<e predictive control for the 
purpose of reducing a model error can be applied without problem. Furthermore, since 
the response of an actual device can be finely adjusted by adjusting the balance of 
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paromctGro gains a and p, the present invention can be applied to, e.g., a 
semiconductor producing equipment, an electronic component mounting device, a robot, 
or a machine tool, which require high-speed response and highly precise positioning. 
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ABSTRACT OF THE DISCLOSURE 



When there exists an error between a model considered in feed-forward and an 
actual device, it Is configured so as to enable the application of control having feed- 
forward such as predictive control without problem to reduce a model error. 
Furthermore, it is configured to enable more fine adjustment of the actual device by 
adjusting the balance of paramctGro gains a and p. An operational unit 169 is provided 
with an error signal calculation unit for outputting an error command and an error 
feedback value based on a position feed-forward signal and a position detection value, 
and an error compensation operation unit for controlling so that the error command and 
the error feedback value coincides with each other. This operational unit 160 is 
provided at a control operation device 109. 



